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The rotation point always lies at the origin of a base coordinate system 
during changes in orientation. The workpiece can be gripped as for 
subsequent machining and manually moved so that characteristic points are 
moved above the fixed workpiece, whereby the orientation is learnt. 

The programmer can specify the nature of the connections between 
points. The base coordinate system can be fixed within the tool. The 
position of the gripper coordinate system is determined in relation to the 
base coordinate system and hence to the tool. 

USE/ADVANTAGE - For use in robot control. The method facilitates 
teaching robots using gripper related interpolation with guided 
workpieces . 
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Bei der numerisch gesteuerten Bearbeitung von WerkstOcken durch eine mehrachsige Maschine, z.B. 
einen Roboter kann es entscheidende technologische Vorteile bringen, wenn gegenuber der herko mm lichen 
Bearbeitung bei der das Werkzeug von der Roboterhand uber ein ortsfestes Werkstuck gefuhrt wird, das 
Werkzeug ortsfest angebracht und das Werkstuck von der Roboterhand uber das ortsfeste Werkzeug 
5 gefuhrt wird. Fur die letztgenannte Bearbeitungsart wird durch die Robotersteuerung eine sogenannte 
greiferbezogene Interpolation vorgenommen, wogegen bei der herkommlichen Fuhrung des Werkzeuges 
uber ein ortsfestes Werkstuck basisbezogen interpoliert wird. 

Die greiferbezogene Interpolation bringt dem Anwender mehrere Vorteile, u. a. wird der Aufbau 
einfacher, man benotigt nur noch einen Greifer und spart die Einspannvorrichtung fur das Werkstuck, ein 
10 ortsfestes Werkzeug unterliegt weniger Beschrankungen in Gewicht und Abmessungen und die Versor- 
gungseinrichtungen fur SchweiGdraht, Kuhlmittel werden deutlich einfacher, da sie nicht uber die Roboterar- 
me zugefuhrt werden mussen. Zweitens erzielt man kurzere Taktzeiten, da man das Werkstuck in einem 
Arbeitsgang ohne Anhalten und Umgreifen heranbringen, bearbeiten und wieder abtransportieren kann. 

Aufgabe der Erfindung ist es bei der greiferbezogenen Interpolation das Teachen mit gefuhrtem 
15 Werkstuck zu erleichtern. Dazu wird eine Variante des kartesisschen Handverfahrens benotigt, bei der 
Translation und Rotation sich auf das ortsfeste Werkzeug beziehen. Insbesondere muB das Werkzeug, das 
als Ursprung des Basiskoordinatensystems gewahlt wird, der Fixpunkt aller Drehungen sein. 

Diese Aufgabe wird durch die Merkmale der Patentanspruche gelost. 

Ein Ausfuhrungsbeispiel der Erfindung wird im folgenden anhand der Zeichnung naher erlautert. Dabei 
20 zeigen: 

FIG 1 bis FIG 4 Veranschaulichung der greiferbezogenen Interpolation, 

FIG 5 die Fuhrung eines an einer Roboterhand angebrachten Werkzeugs uber einem 

ortsfesten Werkstuck, 

FIG 6 die Fuhrung eines an einer Roboterhand angebrachten Werksktucks uber einem 

25 ortsfesten Werkzeug, 

FIG 7 das Lernen der Bahn mit gefuhrtem Werkzeug, 

FIG 8 das Lernen der Bahn mit fest aufgespanntem Werkstuck, 

FIG 9 das kartesische Handverfahren mit Drehungen um die Achsen des Basissy- 

stems, 

30 FIG 10a bis FIG 10c greiferbezogene Handverfahr-Modi im Vergleich. 

Bevor auf das greiferbezogene Handverfahren eingegangen wird, sei anhand der Figuren 1 bis 4 
zunachst das Problem der greiferbezogenen Interpolation veranschaulicht. 

Die Frage, wie sich die Roboterhand andern muB, wenn man nicht das Werkzeug sondern das 
Werkstuck fuhrt, aber die gleiche Relativbewegung zwischen beiden erhalten mochte entzieht sich sehr 

35 schnell dem Vorstellungsvermogen. An einem einfachen zweidimensionalen Beispiel, wie es anhand der 
Figuren 1 bis 4 dargestellt ist, lassen sich einige grundsatzliche Eigenheiten gut klarmachen. FIG 1 zeigt ein 
Werkstuck, dessen Kontur aus geraden Stucken und Kreisabschnitten zusammengesetzt ist. Spannt man 
dieses Werkstuck fest auf, so entspricht die gezeichnete Kontur der Bahn der Werkzeugspitze. Ist das 
Werkzeug rotationssymmetrisch, laSt sich die Kontur mit einer reinen Translationsbewegung abfahren. 

40 Ein gerichtetes Werkzeug muB dagegen immer eine bestimmte Orientierung zur Kontur einhalten. Die 
Anderung der Orientierung ist anhand von FIG 2 durch die an der Kontur angreifenden kleinen Pfeile 
verdeutlicht. Setzt man das Werkzeug fest und bewegt das Werkstuck, zeigen diese beiden Falle sehr 
verschiedene Auswirkungen auf die Bewegung der Roboterhand. In FIG 3 wird das Werkstuck von der 
Roboterhand im Bezugspunkt (= Greifpunkt) gegriffen und es wird die Bewegung dieses Punktes betrach- 

45 tet, die notig ist, um die Kontur am feststehenden Werkstuck entlang zu fuhren. 

Bei rotationssymmetrischen Werkzeug kann die Orientierung des Werkstucks stets beibehalten werden, 
lediglich der Kontakt zwischen Kontur und Werkzeug ist sicherzustellen. Die resultierende Bewegung 
entsteht dann einfach durch Spiegelung der Werkstuckkontur in der Mitte der Verbindungslinie zwischen 
Bezugspunkt und Werkzeug. In diesem Fall laBt sich eine greiferbezogen programmierte Bahn offenbar 

50 sehr einfach umrechnen. Man muB nur alle Stutzpunkte der Bahn spiegeln und kann Abfolge und Lange der 
Bahnsegmente unverandert beibehalten. 

Ein gerichtetes Werkzeug erfordert dagegen eine Umorientierung des WerkstUcks wahrend der Bewe- 
gung, und die Uberlagerung von Verschiebung und Drehung erzeugt eine sehr viel komplexere Bahn des 
Greifpunktes, wie sie in FIG 4 dargestellt ist. 

55 Die Bahn besteht zwar nach wie vor aus geraden Stucken und Kreisabschnitten, deren Anzahl, 
Verteilung und Lange hat sich aber deutlich geandert. An alien Ecken der Kontur verharrt das Werkzeug 
eine Zeit lang am gleichen Punkt, wahrend das Werkstuck um diesen Punkt schwenkt. An Punkt A steht 
dagegen der Greifer still, andert lediglich seine Orientierung, wahrend der groBe Radius des Werkstucks 
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am Werkzeug entlang gefOhrt wird. 

Durch Ecken in der Kontur entstehen dieselben Probleme, wie bei basisbezogener Interpolation mit 
einem raumlich ausgedehnten Werkzeug. Erstens mufi ein zusatzliches Bahnsegment eingefugt werden, 
das lediglich der Umorientierung des Werkstucks dient, zweitens kann diese Umorientierung nicht beliebig 
5 schnell erfoigen. Je groGer der Abstand zwischen Greifpunkt und Werkzeug, desto weiter wird der Weg, 
den der Greifer zuruckzulegen hat. Da die Bahngeschwindigkeit begrenzt ist, muG hierfur eine ausreichend 
groBe Zeitspanne eingeplant werden. 

In den gezeigten Beispielen werden gerade Stucken auf gerade Stucke abgebildet und Kreissegmente 
auf Kreissegmente. Dies liegt jedoch nur an der streng konstant gehaltenen Orientierung des Werkzeugs 
io zur Kontur und kann nicht verallgemeinert werden. Im ubrigen ist festzuhalten, daG sich die Geschwindigkeit 
des Greifers auf den Kreissegmenten durch die Abbildung andert (am deutlichsten an Ecken). Die 
technologist wichtigen Geschwindigkeiten konnen jetzt nur noch greiferbezogen bestimmt werden und 
zwar aus der Bewegung des Werkzeugs relativ zum werkstuckfesten Koordinatensystem. 

Bei der Annaherung an das ortsfeste Werkzeug und nach Ende der Bearbeitung bewegt man das 
75 Werkstuck sinnvollerweise relativ zu einem ortsfesten Koordinatensystem. Man muG daher zwischen beiden 
Interpolationsarten schnell und moglichst auch flieGend mit Hilfe eines Uberschleifsatzes umschalten 
konnen. 

Anhand der Figuren 5 und 6 werden im folgenden die wesentlichen Grundlagen der Interpolation 
beschrieben. FIG 5 zeigt die Fuhrung des Werkzeugs uber ein ortsfestes Werkstuck. Die Bewegung des an 

20 der Roboterhand befestigten Werkzeugs W uber ein ortsfest angebrachtes Werkstuck S stellt den "Normal- 
fall" dar, der hier kurz rekapituliert werden soil. 

Bei einer bekannten Robotersteuerung kann die Bahn des Werkzeugpunktes, dargestellt durch das 
Koordinatensystem WZ relativ zu einem frei wahlbaren werkstuckfesten Basiskoordinatensystem BA ange- 
geben werden. Die Steuerung rechnet diese selbstandig um und zwar zunachst auf Weltkoordinaten WE 

25 (Inertialkoordinaten), dann auf RoboterfuGkoordinaten RO, schlieBlich auf das roboterinterne Koordinatensy- 
stem IRO. Daraus wiederum ermittelt die Rucktransformation die einzustellenden Achssollwerte. Vom 
Programmierer werden also das Basiskoordinatensystem BA relativ zum Inertialkoordinatensystem WE 
sowie einige ausgezeichnete Bahnpunkte (wobei ein Bahnpunkt jeweils durch Position und Orientierung des 
Tool-Center-Points also der Roboterhand bestimmt ist) relativ zu dem Basissystem BA. Die Interpolation 

30 arbeitet in Basiskoordinaten und erganzt somit in Echtzeit die fehlenden Bahnpunkte. Jeder Bahnpunkt muG 
auf Weltkoordinaten BE umgerechnet werden. Die dazu anzuwendende Gleichung erhalt man durch 
Verfolgen der Transformationskette (Gleichung 1 ) 

T WE _ T WE t BAr^-i 1 
I wz - T BA T wz Cal.i 

35 

Wobei T eine Transformationsmatrix ist, die die Position und Orientierung beschreibt. Das Ergebnis erlaubt 
die Berechnung der Achssollwerte gemaG Gleichung 2 

6 = K-'(Twz ,RO ) = K-M(T R0 WE T IR0 R0 )-^Twz WE )G1.2 

40 

wobei K~ 1 fur die Rucktransformation stent 

In FIG 6 ist die Fuhrung des Werkstucks uber einem ortsfesten Werkzeug dargestellt. 

In diesem Fall ist das Werkstuck S fest mit der Roboterhand verbunden und wird uber das stationare 
Werkzeug W, z.B. eine Klebeduse Oder eine SchweiGvorrichtung gefuhrt. Man mochte die Bahn nach wie 
45 vor uber einen werkstuckfesten Koordinatensystem beschreiben und interpolieren. Da aber jetzt das 
Werkstuck bewegt wird, muG sich auch das Bezugssystem mitbewegen. 

Eine einfache und universelle Losung des Problems besteht darin, das Basissystem BA in das ortsfeste 
Werkzeug W zu legen und die Bahn als die "Bewegung" dieses Basissystems BA relativ zum Greifpunkt 
d.h. zum Greiferkoordinatensystem auf dem Werkstuck S zu definieren. Die Bahn des Werkzeugs W wird 
50 also in werkstuckfesten Koordinaten beschrieben. Dies laGt sich durch eine Inversion der basisbezogenen 
Darstellung erreichen. Anstelle von Twz BA wird nun T BA WZ = Owz 8 *) -1 verwendet. Durch Verfolgen der 
Transformationskette erhSIt man Gleichung 3 

Twz WE T BA wz = T BA WE =* Twz WE = Tba we (Tba w2 )~ 1 G 1 «3 

55 

Die Position des Greiferkoordinatensystems WZ dargestellt in Weltkoordinaten, Twz WE . wird genauso 
weiterverarbeitet, wie bei basisbezogener Programmierung. Ist die Bahn in greiferbezogenen Koordinaten 
angegeben, muG man sie demnach zunachst in diesen Koordinaten interpolieren, was sich nicht von einer 

3 
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Interpolation in einem ortsfesten Basissystem unterscheidet. Das Ergebnis Tqa™ 2 ist jedoch in jedem 
Interpolationstakt zu invertieren, noch vor der Umrechnung auf Weltkoordinaten T W2 WE . Im Gbrigen sind 
beide Interpolationsverfahren vollig gleich. 

Greiferbezogene PTP-Satze sind entsprechend zu behandeln. Der Zielpunkt eines solchen Satzes liegt 
ebenfalls als T BA WZ vor, wird daher zunachst invertiert, dann in roboterinterne kartesische Koordinaten 
transformiert und schlieBlich in Achssollwerte. Hier entsteht nur in der Satzaufbereitung ein geringer 
Zusatzaufwand, die achsspezifische Interpolation kann unverandert bleiben. 

Nach diesen Vorbemerkungen wird nun irn folgenden auf das erfindungsgemaBe Verfahren eingegan- 

gen. 

Moglichkeiten der Programmierung 
Darstellung der Bahn 

75 Um fur den Anwender moglichst ubersichtliche Verhaltnisse zu schaffen, sollte die Programmierung der 

Bahn soweit als moglich Von der "sichtbaren" Geometrie des Werkstucks ausgehen und fur bewegtes und 
ortsfestes Werkstuck weitgehend gleich ablaufen. Das einfache zweidimensionale Beispiel in der Einleitung 
zeigt, daB eine Abspeicherung der Bahn der Roboterhand reiativ zum ortsfesten Werkzeug zwar prinzipiell 
moglich ist (auch sie besteht nur aus Geraden und Kreisbogen), aber sehr unanschaulich wird. Es bleibt 

20 also nur die Darstellung der Bahn des Werkzeugs reiativ zu einem Punkt auf dem Werkstuck, ungeachtet 
der Tatsache, daB das Werkzeug ortsfest ist. 

Neben der groBeren Anschaulichkeit hat diese Methode den Vorteil, daB die Bahndefinition nicht nur 
durch Lernen (Teach-In) mit bewegtem Werkstuck, sondem auch durch Lernen an einem fest aufgespann- 
ten Werkstuck Oder durch Ubernahme von CAD-Daten erfolgen kann, wobei die Schnittstelle zur Interpola- 

25 Won stets gleich bleibt. 

Lernen mit gefuhrtem Werkstuck 

Bei diesem Ansatz wird das Werkstuck genauso gegriffen wie bei der spateren Bearbeitung und im 
30 Handbetrieb so bewegt, daB charakteristische Punkte der Kontur uber das ortsfeste Werkzeug zu stehen 
kommen (Fig 7) Dabei muB naturlich auch die Orientierung gelernt werden. Der Programmierer spezifiziert 
auGerdem, wie diese Punkte durch CP- oder PTP-Satze zu verbinden sind. Das Basiskoordinatensystem 
sollte in das Werkzeug gelegt werden. Abgesehen von der Tatsache, daB Werkzeug- und Basiskoordinaten- 
system hier ihre Rollen vertauschen, besteht fur den Anwender kein Unterschied zur basisbezogenen 
35 Programmierung. 

An jedem der gelernten Bahnpunkte sind der Steuerung bekannt: 

- Position des Werkzeugs in Weltkoordinaten: T BA WE 

- Position des Greifers (des TCP): T WZ WE 

Wie beim basisbezogenen Lernen berechnet man daraus die Position des Greiferkoordinatensystems in 
40 Bezug auf das Basissystem, also hier in Bezug auf das ortsfeste Werkzeug 

X BA _ / T WE\-l t WE 
I WZ ~ ( I BA ) I WZ 

Um den gelernten Punkt in Werkstuckkoordinaten zu speichern, muB dieses Ergebnis lediglich invertiert 
45 werden 

Tba^ = <Twz BA r 1 = <Twz WE r T BA WE 

Die von der Interpolation erzeugten Bahnpunkte werden ein zweites Mai invertiert, so daB sich insgesamt 
so genau die gelernte Bahn ergibt. 

Sollte das Werkzeug nicht wirklich ortsfest sein, sondern z.B. durch Zusatzachsen bewegt werden, ist 
T BA WE ebenfalls abzuspeichern, um eine spatere Interpolation der Werkzeugbewegung zu ermoglichen. 

Die Bahn konnte auch auf ein anderes werkstOckfestes Koordinatensystem als das des Greifers 
umgerechnet und in diesem Format gespeichert werden. Fur das Lernen und die spatere Interpolation 
55 wurde das jedoch keine Vorteile bringen. 
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Lernen mit feststehendem Werkstuck (FIG 8) 

Das Lernen mit gefuhrtem Werkstuck kann gelegentlich als "unhandlich" erscheinen. Normalerweise 
wird beim kartesischen Handverfahren stets der Ursprung des Greiferkoordinatensystems als Bezugspunkt 

s fur Verschiebungen und Drehungen verwendet, urn die Hand reiativ zu einem ortsfesten Werkstuck leicht 
positionieren zu konnen. 1st dies der einzige vorgesehene Handverfahr-Modus, muB der Programmierer bei 
Anderungen der Orientierung eines groGen Werkstucks moglicherweise ungewohnt schnelle Relativbewe- 
gungen zwischen Werkzeug und Kontur beherrschen. AuGerdem kann er bei einem aufwarts gerichteten, 
fest montierten Werkzeug sein Arbeitsfeld manchmal schlecht uberblicken, so daB ein exaktes Lernen 

w schwierig wird. 

Zur Erleichterung solcher Aufgaben kann die Bahn auch an einem fest montierten Muster-Werkstuck 
definiert werden. Es geht schlieBlich nur darum, die Bahn in einem bekannten, werkstuckfesten Koordina- 
tensystem zu beschreiben, nach Moglichkeit in demselben System, das spater als Greiferkoordinatensy- 
stem verwendet wird. 

75 Wahrend des Lernvorganges befestigt man an der Roboterhand sinnvollerweise einen "Zeiger" mit 

bekannten Abmessungen, so daB die Position des in diesen Zeiger geiegten Werkzeugkoordinatensystem 
reiativ zum Inertialsystem, T W z WE » jederzeit aus den Achsstellungen berechnet werden kann. 

Das Muster-Werkstuck wird so aufgespannt, daB die Position des Basiskoordinatensystems, in dem die 
Bahn definiert wird, in Bezug auf die Weltkoordinaten bekannt ist (T BA WE ). 

20 Die zu lernenden Punkte werden mit dem "Zeiger" angefahren; aus den bekannten Positionen des 

Greifers und des Werkstucks in Weltkoordinaten berechnet man die Position des Greifers in Werkstuckkoor- 
dinaten 

T BA _ / X WE\-1 t WE 
I WZ - ( I BA ) I WZ 

25 

und speichert dies als Bahnstutzpunkt ab. Bis hierher unterscheidet sich die Vorgehensweise von jedem 
"normalen" Lernvorgang nur dadurch, daB noch nicht das endgultige Werkzeug bzw. der endgultige Greifer 
verwendet wird. 

Beim Bearbeitungsvorgang werden die so gelernten Daten lediglich anders interpretiert Anstelle des 
30 "Zeigers" wird nun das Werkstuck an der Hand befestigt, als "Werkzeugkoordinatensystem" (Greiferkoordi- 
natensystem) wird nun das Bezugssystem der Bahn verwendet. Die geanderte Lage dieses Koordinatensy- 
stems reiativ zum Flansch ist der Steuerung mitzuteilen. Das Basissystem BA wird nun in das ortsfeste 
Werkzeug gelegt auch diese Anderung muB der Steuerung bekanntgemacht werden. 

Die reiativ zum Basissystem gelernte Bahn wird nun genauso verwendet, als sei sie von vornherein 
35 reiativ zum Greiferkoordinatensystem definiert worden, d.h. die als Twz BA abgespeicherten Punkte werden 
nun als T BA WZ interpretiert, ohne an den Zahlenwerten etwas zu andern. 

Die Bahndefinition am fest montierten Werkstuck nutzt den Roboter als MeGmaschine. Da bei diesem 
Verfahren wahrend der Bearbeitung die Hand nicht auf der gleichen Bahn fahrt wie bei der Programmierung 
(vgl. das Beispiel in der Einleitung), stellt es hohere Anforderungen an die absolute Genauigkeit des 
40 Roboters, des Werkstuckes und der Aufspannung als das Lernen mit gefuhrtem Werkstuck. Hinzu kommen 
unterschiedliche Durchbiegungen des Arms durch die verschiedenen Traglasten bei Programmierung und 
Bearbeitung sowie eine Verformung des Werkstucks durch die veranderte Lage. 

Erganzende Bemerkungen 

45 

Das basisbezogene Lernen (Teach-in) orientiert sich an folgenden Grundsatzen: 

1. Es wird immer die Position des Greiferkoordinatensystems reiativ zum Basissystem $BASE abgespei- 
chert (Twz BA = $POS__ACT). 

2. Dazu wird das aktueti eingeste/lte Basissystem herangezogen. Der Anwender muB selbst dafur 
so sorgen, daB bei der spateren Programmbearbeitung dieselbe Oder eine definiert veranderte Basis 

eingestellt wird. 

3. Istwerte werden entweder achsspezifisch Oder kartesisch angezeigt. Die kartesische Darstellung 
bezieht sich auf SBASE. 

4. Die gelernte Position dart auch einem Frame zugewiesen werden (z. B. SBASE), um ein neues 
55 Bezugskoordinatensystem zu definieren. 

5. Es ist vorgesehen, uber eine "Voreinstellungs"-Maske nur ausgewahlte Komponenten einer Position 
zu ubernehmen. Die anderen sind dann als "nicht inttialisiert" gekennzeichnet (Lucken) und mussen 
wahrend der Bewegungspianung erganzt werden. 
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6. Durch Lernen konnen Aggregate (strukturierte Konstanten) Oder Variabten aus Datenlisten festgelegt 
werden. Letztere werden wie initialisierte Variable behandelt, sind bei der Programmbearbeitung also 
schreibgeschutzt. 

Fur das greiferbezogene Lernen (mit gefiihrtem Werkstuck) folgt in konsequenter Fortsetzung dieses 
5 Konzepts: 

1. Neben dem Basissystem SBASE muG nun auch der "Interpolationsmodus" (basisbezogen oder 
greiferbezogen) beachtet werden. 

2. Im greiferbezogenen Betrieb wird die Position des Basissystems relativ zum Greiferkoordinatensy- 
stem, also T BA WZ abgespeichert. 

w 3. Dazu werden das aktuell eingestellte Basissystem und der aktuetl eingestellte Interpolationsmodus 
herangezogen. Der Anwender muG selbst dafur sorgen, daG bei der spateren Programmbearbeitung die 
gleichen oder definiert veranderte Verhaltnisse vorliegen. 

4. Die Anzeige der Istwerte erfolgt entweder achsspezifisch oder kartesisch, die kartesische Darstellung 
zeigt bei greiferbezogener Interpolation die Position des Basissystems relativ zum Greiferkoordinatensy- 

15 stem, also Tba™ 2 - 

5. Beim Fullen nicht initialisierter Komponenten, die durch die Voreinstellungs-Maske entstehen konnen, 
muG die Bewegungsplanung beachten, daG die vorhergehende Position eventuell noch basisbezogen 
angefahren wurde und daher erst auf greiferbezogene Darstellung umgerechnet werden muB. 

Im ubrigen kann das Konzept fur basisbezogenes Verfahren beibehalten werden. 

20 

Kartesisches Handverfahren 
Bezugssysteme fur Translation und Rotation 

25 Zur Beschleunigung des Lernvorgangs (Teachen) mit gefuhrtem Werkstuck wird mindestens eine 
weitere Variante des kartesischen Handverfahrens benotigt, bei der Translation und Rotation sich auf das 
ortsfeste Werkzeug beziehen. Insbesondere muG das Werkzeug, also der Ursprung des Basissystems, der 
Fixpunkt aller Drehungen sein. Die bisher in der ACR vorgesehenen Handverfahr-Modi erlauben zwar 
Orientierungsanderungen relativ zum Basissystem, halten dabei aber den Ursprung des Greiferkoordinaten- 

30 systems (Arbeitspunkt) fest, d.h. fur Drehungen wird nur die Richtung der Koordinatenachsen des Basissy- 
stems ausgewertet nicht aber seine Position. FIG 9 verdeutlicht den Unterschied am Beispiel einer Drehung 
urn die x-Achse des Basissystems. 

Wie man sofort erkennt, wird durch Drehungen urn den Ursprung des Basiskoordinatensystems die 
Programmierung sehr erleichtert, da Position und Orientierung des Werkstucks direkt am Werkzeug 

35 voneinander entkoppelt sind. 

Tabelle 1 stellt die bisher vorgesehenen Handverfahr-Modi der ACR zusammen. Intern werden drei 
Falle unterschieden: 

1. Translation langs der Achsen eines ortsfesten Koordinatensystems und Rotation um die Achsen 
desselben System, allerdings bei festgehaltenem Arbeitspunkt (MOV, der oben beschriebene Fall, Bild 6 

40 links), 

2. Translation langs der Achsen eines ortsfesten Koordinatensystems, Rotation um die Achsen des 
Greiferkoordinatensystems (TMOV), 

3. Translation und Rotation langs der bzw. um die Achsen des Greiferkoordinatensystems 
(MOV_TOOL). 

45 



50 



55 
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Bezugssystem 


Rotation 


5 


Translation 


WORLD 


BASE 


ROBROOT 


TCP 




\A/nm n 

WUnLU 


MOV 






TMOV 


10 


BASE 




MOV 




TMOV 




ROBROOT 






MOV 


TMOV 


15 


TCP 








MOV_TOOL 



Tabelle 1: Varianten des kartesischen Handverfahrens 



Um die gewunschte Wirkung, namlich Drehungen um den Ursprung des Basissystems, zu erzielen, hat 
man nun zwei Moglichkeiten: Man interpoliert basisbezogen Oder greiferbezogen. 

25 Basisbezogenes Handverfahren 

Beschrankt man sich ausschlieBlich auf basisbezogene Handverfahr-Modi, muB ein vierter Fall einge- 
fuhrt werden (im folgenden mit BMOV bezeichnet): 

4. Translation langs der Achsen eines ortsfesten Koordinatensystems und Rotation um die Achsen 
30 desselben System, wobei diese als feststehende Drehachsen zu interpretieren sind, also nicht nur die 
Drehrichtung angeben (Bild 6 rechts). 

Grundsatzlich sind dieselben Bezugskoordinatensysteme zulassig wie in den ersten beiden Fallen. Die 
Verwendung von SWORLD und SROBROOT durfte allerdings keinen praktischen Nutzen bringen. Es ist 
daher zu uberlegen, ob dieser Modus auf SBASE eingeschrankt werden muB (z. B. aus Sicherheitsgrun- 
35 den). Eine solche zusatzliche Fallunterscheidung durfte andererseits einen hoheren Implementierungsauf- 
wand bedeuten, da das bisherige, regelmaBige Schema durchbrochen wurde. 

Im Hinblick auf Zustandsubergange, z. B. vom Prog ram m- Mod us in den Kommando-Modus und zuruck, 
kann die gleiche Strategie verwendet werden wie beim gewohnlichen kartesischen Handverfahren. 

40 Greiferbezogenes Handverfahren 

"Greiferbezogenes Handverfahren" steht hier nicht fur den oben beschriebenen Fall MOV TOOL, in 

dem Translation und Rotation des Greifers anhand der Ausrichtung des Greiferkoordinatensystems berech- 
net werden (relativ zum Basiskoordinatensystem).Vielmehr wird nun die Bewegung des Basissystems 
45 relativ zum Greiferkoordinatensystem uber die Handverfahrtasten vorgegeben. 

Durch diesen Wechsel des Blickwinkels erhalt man zu jedem der drei bereits definierten Modi eine 
neue, greiferbezogene Variante. Alle drei erfullen das Kriterium, daB bei Orientierungsanderungen der 
Arbeitspunkt, der nun im Basissystem angesiedelt ist, konstant bleibt. Sie unterscheiden sich in der Wahl 
der Bezugssysteme fur Translation und Rotation (FIG 10a - 10c) 
so 1. Translation (des Basiskoordinatensystems) langs der Achsen des Greiferkoordinatensystems und 
Rotation um die Achsen desselben Systems, bei festgehaltenem Arbeitspunkt (MOV greiferbezogen), 

2. Translation langs der Achsen des Greiferkoordinatensystems, Rotation um die Achsen des Basiskoor- 
dinatensystems (TMOV greiferbezogen), 

3. Translation und Rotation langs der bzw. um die Achsen des Basiskoordinatensystems (MOV TOOL 

55 greiferbezogen). Dies entspricht nahezu dem basisbezogenen Modus BMOV. 

Ein Vorteil dieses Ansatzes besteht darin, daB mit geringem Aufwand drei Handverfahr-Modi zur 
Verfugung stehen, basisbezogene und greiferbezogene Interpolation werden auch im Handbetrieb gleichbe- 
rechtigt behandelt. AuBerdem ist bei einer Unterbrechung eines greiferbezogen interpolierten Satzes 



7 



EP 0 671 246 A2 



automatisch ein Handverfahr-Modus eingestellt. der das Basiskoordinatensystem als Arbeitspunkt betrachtet 
und somit alle Drehungen urn diesen Punkt erfolgen laBt. Wie bei der Diskussion von Einzelsatzen im 
Kommando-Modus noch klarer werden wird, erreicht man auf diesem Weg ein homogeneres System. 

Als moglicher Nachteil ist festzuhalten, daB alle Bewegungen fur den ortsfesten Beobachter in 
5 entgegengesetzter Richtung erfolgen. Wenn etwa das (ortsfeste) Werkzeug in positiver x-Richtung des 
Greiferkoordinatensystems verschoben werden soil, muB sich der Greifer in negativer x-Richtung bewegen. 
Fur den Programmierer kann dies gewohnungsbedurftig sein. Auf jeden Fall muG er durch eine entspre- 
chende, greiferbezogene Istwert-Anzeige unterstutzt werden. 

io Mathematische Formulierung der Interpolation mit homogenen Transformationen 

Ziel dieses Abschnittes ist eine einheitliche Ableitung der Gleichungen fur die verschiedenen Handver- 
fahr-Modi. Dabei steht die Ubersicht im Vordergrund; die konkret zu implementierenden Gleichungen folgen 
erst im nachsten Abschnitt. Ferner wird zunachst nur das rein bastsbezogene Handverfahren betrachtet. Der 
75 Ubergang auf greiferbezogene Darstellung ist dann relativ einfach und wird in Abschnitt 4.4 besprochen. 

Alle fur das Handverfahren relevanten Koordinatensysteme sind in FIG 11 zusammengestellt. Im 
folgenden steht BEZ fur ein beliebiges ortsfestes Bezugssystem (SWORLD, SBASE, SROBROOT), IRO fur 
das roboterinterne Koordinatensystem, auf das alle kartesischen Sollwerte vor der Rucktransformation 
umgerechnet werden mussen, und WZ fur das Greiferkoordinatensystem, das bei der Interpolation fortlau- 
20 fend neu berechnet wird. WZ* gibt die Lage des Greiferkoordinatensystems im nachsten Interpolationstakt 
an. 

Beim kartesischen Handverfahren werden die drei Koordinaten x, y, z und die Roll-, Pitch- und Yaw- 
Winkel (RPY-Winkel) A, B, C interpoliert (bei Robotern mit weniger als sechs Freiheitsgraden entfallen 
einzelne Winkel). Die Frage, wie diese Koordinaten in jedem Interpolationsschritt bestimmt werden, sei 
25 zunachst zuriickgestellt. 

Ausgehend von den fur einen Abtastschritt gultigen Differenzen Ax, Ay, Az, AA, AB. AC kann man eine 
homogene Translations- und eine Rotationsmatrix angeben, die zusammengenommen das Koordinatensy- 
stem WZ in das System WZ' uberfuhren: 



30 



35 



40 



45 



Trans ( Ax. Ay. Az ) 



Rot ( AA. AB. AC ) = 



1 0 0 

0 1 0 

0 0 1 

0 0 0 



Ax 
Ay 

AZ 
1 J 



RPY(AA.AB.AC) , 0 
i 0 

— 

u 



0 0 0 



AC 



. 0 0 0, 1 J 



AR 



. 0 0 0, 1 . 



RPY ( AA. AB. AC ) = Rot( z, AA ) Rot( y. AB ) Rot( x. AC ) 

+ Ca Sq Sr* S q + C^SqGq 



S A C B 



^aCq + °B °C 
C A C C + S A S B S C 



-S 



B 



8 



-c A s 



A°C 



S A S B C ( 



C Q C 



B °C 



50 mit C A = cos ( AA ), S A = sin ( AA) usw. 

Die Reihenfolge von Translation und Rotation ist signifikant: 



55 
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Rot • Trans = 


AR 
_0 0 0 


i -| 
| 0 

i 1 


i 

I J AD 
0 0 0 11 

L , J 




1 

AR 'ARAB 
i 

0 0 0' 1 
L- I -» 


Trans ♦ Rot = 


AR 


i 

| AQ 







0 0 0' 1 



Insgesamt erhalt man daher sechs einfache Moglichkeiten der Anwendung dieser differentiellen Transfor- 



mationen: 






1. 


I wz' - 


Trans Rot T WZ BEZ 


2. 


t BEZ 
I WZ' 




Trans T W2 BEZ Rot 


3. 


T BEZ 
I WZ" 




Twz BEZ Trans Rot 


4. 


t BEZ 
I WZ' 




Rot Trans T WZ BEZ 


5. 


T BEZ 
I WZ" 




Rot T WZ BEZ Trans 


6. 


T BEZ 
1 WZ' 




T WZ BEZ Rot Trans 



20 Dabei bedeutet jede Multiplikation von links, dafl die betreffende Transformation in den Bezugskoordinaten 
ausgefuhrt wird, jede Multiplikation von rechts dagegen eine Operation in Greiferkoordinaten. 

Die Kombination [Trans Rot] ist in der Praxis deutlich einfacher zu handhaben als [Rot Trans], da 
Translation und Rotation entkoppelt wirken. Somit sind nur noch die ersten drei Falle von praktischem 
Interesse. 

25 Die erste Form, [Trans Rot Twz BEZ ], stellt den bisher nicht implementierten Modus BMOV dar: Ein in 
Bezugskoordinaten beschriebenes Greiferkoordinatensystem wird zunachst um die Achsen des Bezugsko- 
ordinatensystems gedreht (Multiplikation mit Rot von links), dann in Bezugskoordinaten verschoben (Multi- 
plikation mit Trans von links). 

Die zweite Variante entspricht dem Modus TMOV: Alle Verschiebungen erfolgen in Bezugskoordinaten, 

30 alle Drehungen verwenden die Achsen des Greiferkoordinatensystems (Multiplikation mit Rot von rechts). 

Der dritte Fall beschreibt den Modus MOV TOOL: Zunachst wird in Greiferkoordinaten verschoben, 

dann um die Achsen des verschobenen Systems gedreht. 

Der Modus MOV hat keine Entsprechung dieser einfachen Form. Wollte man die Rechenoperationen 
durch Multiplikation homogener Matrizen beschreiben, muGte man T W z BEZ erst einmal von seinem translato- 

35 rischen Anteil befreien (in den Ursprung des Bezugskoordinatensystems verschieben), dann von links mit 
Rot multiplizieren, den translatorischen Anteil wieder zufugen und schlieBlich auch die Verschiebung Trans 
von links heranmultiplizieren. Erst durch Zusammenfassung der Sequenz aus Verschiebung in den Ur- 
sprung, Rotation und Ruckverschiebung zu einer homogenen Matrix Rot" erhalt man wieder einen einfachen 
Ausdruck: 

40 7. (T WZ ' BE2 )mov = Trans Rot* T W2 BEZ 
mit 



45 



Rof = 



Q 



AR ! 0 



0 0 0 



0 0 0 1 



AB i -AB Q + D 
1 



ooo; 1 



0 0 0 



1 



Betrachtet man translatorischen und rotatorischen Anteil innerhalb der homogenen Matrizen getrennt, 
50 kommt man allerdings zu einer effizienteren Rechenvorschrift (die in der ACR bereits implementiert ist). 

4.3 Berechnung von Translation und Rotation 

Die mit Hilfe homogener Matrizen dargestellten Transformationsvorschriften fur die verschiedenen Modi 
55 dienen vor allem der analytischen Beschreibung. Fur die numerische Implementation ist es sinnvoller, alle 
Matrizenmultiplikationen vorweg auszufuhren. Verschiebung und Drehung konnen dann mit deutlich weniger 
Rechenoperationen und getrennt voneinander berechnet werden. 
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Durch Partitionieren der aktuellen Greifermatrix Twz BEZ in einen rotatorischen Anteil R und einen 
translatorischen Anteil p erhalt man: 



10 



15 



20 



25 



(T W 2* 8E2 )bmov = Trans Rot T W2 BEZ = 



(Twz- BE2 )mov = Trans Rot* T W2 BE * 



(Tw2' BEZ )tmov = Trans T W2 SEZ Rot = 




„ooo| 1 J Lo o o ; 1 J Lo o o ! 1 . 



BAB i Q + Aq 
X 



L o o o ; 1 



30 



35 









1 


= T WZ BEZ Trans Rot = 


b i q 




ar Jab 


.0 0 0 ! 1 . 




.0 0 0 1 . 




1 





RAR i R Ac + c 
1 



0 0 0 



1 



Alle Gleichungen liefern ihr Ergebnis im Bezugssystem der am weitesten links stehenden Abbildungsmatrix. 

40 Welt-, RoboterfuB- und Basiskoordinaten (SWORLD, SROBROOT, $BASE) sind gleichermaBen sinnvoll. Die 
Verwendung des Greiferkoordinatensystems ware zwar formal korrekt (mit R = I und p = 0), wurde aber in 
alien vier Fallen nur noch greiferbezogene Bewegungen zulassen, scheidet hier also aus. Das Ergebnis der 
Berechnungen liegt somit immer in einem ortsfesten Koordinatensystem vor oder zumindest in in einem 
Koordinatensystem, dessen Bewegung von vornherein bekannt ist (bei Verwendung von $BASE mit 

45 Zusatzachsen). 

Aus Grunden der Einheitlichkeit wurden die Gleichungen bis hierher mit differentiellen Translationen 
und Rotationen formuliert. Bei einigen Modi kann man jedoch auch mit absoluten Angaben arbeiten, d.h. in 
jedem Interpolationstakt nicht den Unterschied zum vorhergehenden Takt angeben, sondern den Unter- 
schied zum Beginn der Bewegung. Dies gilt fur alle Abbildungsgleichungen, in denen die differentiellen 
50 Werte immer in Bezugskoordinaten formuliert sind, d.h. einfach addiert oder von links heranmultipliziert 
werden. 

Demnach kann man in den Modi BMOV und MOV sowohl die Rotation AR als auch die Verschiebung 
Ap absolut angeben, im Modus TMOV immerhin noch die Verschiebung. Die Variante MOV__TOOL laBt 
dagegen nur differentielle Operationen zu, da sich das Bezugssystem WZ(R, p) in jedem Interpolationstakt 
55 andert. 
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Mathematische Formulierung des greiferbezogenen Handverfahrens 



Nach der Formulierung des basisbezogenen Handverfahrens sind bereits alle notwendigen Grundlagen 
gelegt. Der einzige Unterschied besteht im Wechsel des Blickwinkels: anstelle der Bewegung des Frames 
5 WZ relativ zu BEZ gibt man nunmehr BEZ reiativ zu WZ an, muB demnach die Gleichungen fur die 
Anderung von einem Interpolationstakt zum nachsten folgendermaGen ansetzen: 
1 • (T 8 ez wz )bmov = Trans Rot T BEZ WZ (BMOV greiferbezogen) 

2. (T B ez wz )mov = Trans Rot* T BE z wz (MOV greiferbezogen) 

3. (Tbez-^tmov = Trans T BE2 WZ Rot (TMOV greiferbezogen) 

10 4. (Tbez-^mo^tool = T BE z wz Trans Rot (MOV_TOOL greiferbez.) 

Der erste Fall (BMOV) ist nur der Vollstandigkeit halber aufgefuhrt, er wurde den Ursprung des 
Greiferkoordinatensystems zum Arbeitspunkt machen, was durch das greiferbezogene Handverfahren 
gerade vermieden werden soil. Ferner durfte in der Praxis nur BEZ = BA sinnvoll sein (wie beim 
basisbezogenen BMOV). 

rs Der Rechengang bei den anderen Modi deckt sich nahezu mit dem basisbezogenen Handverfahren. Es 

muG lediglich 

1. zu Beginn des Handverfahrens die Startposition T B ez wz bereitgestellt werden, d.h., falls gerade auf 
greiferbezogene Interpolation umgeschaltet wurde, ist T BEZ WZ = (T WZ BEZ )~ 1 zu berechnen, 

2. die greiferbezogen berechnete neue Position T BEZ WZ in jedem Interpolationstakt in eine basisbezogene 
20 Darstellung umgerechnet werden, T WZ BEZ = (T BE z ,wz )~ 1 - 

Davon abgesehen konnen die oben abgeleiteten Gleichungen unverandert zum Einsatz kommen. Man 
erkennt die Verwandtschaft dieser Losung zur greiferbezogenen Interpolation bei der Programmbearbeitung 
(Abschnitt 2.2), fur die ebenfalls nur Frame-lnversionen bei der Satzaufbereitung (s. auch Abschnitt 7) und 
nach jedem Interpolationstakt eingefuhrt werden. 
25 Man kann die Inversionen naturlich auch vorweg analytisch durchfuhren, so daG die Gleichungen in 

basisbezogener Darstellung vorliegen: 

1- (Twz BEZ )bmov = Twz BEZ (Rot)" 1 (Trans)" 1 

2. (Twz BEZ )mov_tool = Twz BEZ (Rot')" 1 (Trans)" 1 

3. (T WZ BEZ W = (Rot)" 1 T W2 BEZ (Trans)" 1 
30 4. (T WZ BEZ W = (Rot)" 1 (Trans)" 1 T W2 BEZ 

Die Inversionen der differentiellen Rotationen und Translationen gestalten sich relativ einfach, da nur die 
difference Hen Verschiebungen und Verdrehungen (Ax bis AC) das Vorzeichen wechseln. Andererseits ist 
aber auch die Reihenfolge von Rotation und Translation vertauscht, man konnte also nicht die vorhandenen 
Algorithmen benutzen, sondern muBte neue ableiten und implementieren. 
35 Zugunsten einer moglichst homogenen Struktur der Steuerung durfte es daher giinstiger sein, die 
Interpolation greiferbezogen durchzufuhren, mit nachfolgender Inversion in jedem Interpolationstakt. Die 
basisbezogene Darstellung mag lediglich verdeutlichen, daG diese Handverfahr-Modi sich tatsachlich von 
den bishervorhandenen unterscheiden und daG ein ortsfester Beobachter alle differentiellen Verschiebungen 
und Verdrehungen mit umgekehrtem Vorzeichen sieht. 

40 

Transformation in roboterinterne Koordinaten 



Die in Bezugskoordinaten berechneten Positionen des Greiferkoordinatensystems (T W z BEZ ) mussen zur 
Berechnung der Achssollwerte in roboterinterne Koordinaten umgerechnet werden. Da, wie oben dargelegt, 
45 die Bewegung des Bezugskoordinatensystems als bekannt vorausgesetzt werden kann, erhalt man relativ 
einfache Transformationsvorschriften. 

Mit der Abkurzung BEZ fur das Bezugskoordinatensystem gilt allgemein 

T BEZ - -r BEZ T IRO ^ t WZ - /t BEZ\-i T BEZ 
1 WZ - I IRO 1 WZ hRO - ( I IRO ) I WZ 

50 

Die jeweils anzuwendende Transformationsmatrix folgt aus der nachstehenden Tabelle: 



BEZ 


T BEZ 
» IRO 


/t BEZ\-i 
( 1 IRO ) 


SBASE 

SWORLD 

SROBROOT 


/T WEx-i y WE t RO 
( ' BA ) 1 RO 1 IRO 
X WE t RO 

T ro T| RO 

t RO 

Tiro 


(T R0 WE t iro ro )-' t ba ^ 

(T R0 we T iro ro 
(T,ro ro 
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Erzeugung der Geschwindigkeitsproflle 

Der zeitliche Verlauf von Ax, Ay, Az, AA, AB und AC kann fur den neuen Modus BMOV in der gleichen 
Weise erzeugt werden wie bei den bestehenden Modi. Es ist keine Sonderbehandlung notwendig. 

Konkret heiBt dies, daB fur jede Bewegungsrichtung (jede Komponente Ax bis AC) ein "Endlosprofit" 
berechnet wird, das nur aus einer Phase konstanter Geschwindigkeit besteht. Der Geschwindigkeitssprung 
zu Beginn und Ende der Bewegung wird von der Override-Regelung verschliffen. 

Die genannten konstanten Geschwindigkeiten sind durch Maschinendaten vorgegeben und nur fur die 
Komponenten wirksam, deren Verfahrtasten gedruckt gehalten werden. Alle anderen Komponenten sind 
Null. 

Patentanspruche 

1. Robotersteuerung mit einem greiferbezogenen Handverfahren, dadurch gekennzeichnet, dafl der 
Drehpunkt bei Orientierungsanderungen immer im Ursprung eines Basiskoordinatensystems liegt. 
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WE 

Bild 1: Fuhrung des Werkzeugs uber ein ortsfestes Werkstuck 




Bild 2: Fuhrung des Werkstucks iiber ein ortsfestes Werkzeug 

FIG £ 
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Bild 3: Lernen der Bahn mit gefuhrtem Werkstuck 



EP 0 671 246 A2 




Bild 4: Lernen der Bahn mit fest aufgespanntem Werkstuck 
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BAf 



B/ 



Dre r h r U " 9 e " m i en Unsprung des Drehung urn den Ursprung des 

Greiferkoord.natensystems ^ , g g Basiskoordinatensystems 

Bild 6: Kartesisches Handverfahren mit Drehungen 
urn die Achsen des Basissystems 
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